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机 器 人 低 运 算 要 求 的 动态 步 态 的 实现 方法 
(57) 摘要 PR 
本 发 明 涉及 机 器 人 和 创 客 教育 领域 ,具体 涉 Eh TAR 
及 一 种 低 运算 要 求 的 动态 步 态 的 实现 方法 。 该 方 | 
法 包括 :根据 机 器 人 的 腿 部 结构 ,建立 单 腿 运动 \ 
学 模型 ,推导 机 器 人 人 单 腿 的 逆 运 动 学 公式 ;设计 恨 据 机 器 人 运动 轨迹 ， 选 择 多 个 运动 
步 态 :使 用 对 应 的 步 态 ,使 机 器 人 当 行走 时 的 质 点 来 模拟 机 器 人 足 六 的 一 个 运动 周 
心 惯性 力 和 重力 的 合力 的 延长 线 穿 过 机 器 人 的 j 
支撑 面 ;将 步 态 周期 中 每 只 足 端 的 坐标 代入 逆 运 
动 学 公式 中 ,得 出 每 个 关节 角 , 并 映射 到 舵 机 值 。 将 运动 点 代入 逆 运 动 学 公式 ， 计 算 | 
直接 使 用 能 机 值 就 可 完成 整个 步 态 周期 ,这 样 就 在 各 个 时 刻下 的 各 个 关节 的 运动 角度 
可 以 免 去 大 量 的 运算 , 主 控 芯片 的 资源 可 以 使 用 
在 其 他 更 需要 的 方面 ,这 在 创 客 教育 中 是 极其 重 


要 的 te HA zs FE. MEL AY tc ee Fy AA Fy PE Fa a BY 
Sous 时 到 能 机 具体 位 置 值 ， 控 制 能 机 完成 整个 步 态 
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1 .一 种 机 器 人 低 运 算 要 求 的 动态 步 态 的 实现 方法 ,其 特征 在 于 ,包括 以 下 步骤 : 

模型 建立 :根据 不 同 的 腿 型 结构 ,建立 单 腿 运动 学 模型 并 且 采 用 对 应 的 逆 运 动 学 公式 ; 
确定 步 态 :根据 机 器 人 运动 轨迹 ,选择 多 个 运动 点 来 模拟 机 器 人 足 端 的 一 个 运动 周期 ; 
运动 角度 的 确定 :将 运动 点 代入 逆 运 动 学 公式 ,计算 出 在 各 个 时 刻下 的 各 个 关节 的 运 


ON) FA FE 
BP AS SEEM s MEP EIS BH FA RE EAL BeBe yh A A PE E PE AL E Pe IE 
机 完成 整个 步 态 ; 


企 步 态 实 现 步骤 中 ,将 所 有 关节 的 运动 角度 根据 舵 机 的 安装 方式 和 角度 范围 映射 到 能 
机 具体 位 置 值 ,并 且 规 定 相 应 的 速度 , 主 控 蕊 片 发 送 舱 机 具体 位 置 值 给 舵 机 ,控制 舵 机 在 一 
定时 间 内 转动 到 特定 角度 , 即 完成 整个 步 态 的 实现 ; 

在 确定 步 态 步骤 中 ,多 个 点 的 选择 按照 以 下 规则 :根据 机 器 人 的 运动 轨迹 , 选 定 进行 落 
足 和 抬 足 时 运动 的 第 一 个 点 作为 落 足 点 和 抬 足 点 ,在 落 足 点 和 抬 足 点 的 连 线 上 选择 中 点 ， 
且 在 中 点 的 正 上 方 根据 抬 腿 高 度 再 选取 一 点 ,将 这 些 点 连接 起 来 形成 机 器 人 足 部 的 运动 轨 
迹 , 构 成 机 器 人 足 端的 一 个 运动 周期 

根据 运动 轨迹 中 各 个 点 之 间 的 距离 ,赋予 相对 应 的 时 间 ,使 得 机 器 人 在 行走 的 过 程 中 
保持 匀速 运动 。 

2. 根 据 权 利 要求 1 所 述 的 机 器 人 低 运 算 要 求 的 动态 步 态 的 实现 方法 ,其 特征 在 于 ,在 模 
型 建立 步骤 中 ,不同 的 机 器 人 有 具有 不 同 的 腿 型 ,机 器 人 共有 三 种 ,包括 双 足 机 器 人 、 四 足 机 
器 人 和 六 足 机 器 人 ,对 应 的 腿 型 也 为 这 三 种 ;运用 仿生 学 原理 将 三 种 腿 型 建立 对 应 的 单 腿 
运动 学 模型 ,并 且 推 导出 逆 运 动 学 公式 。 

3. 根 据 权 利 要 求 2 所 述 的 机 器 人 低 运 算 要 求 的 动态 步 态 的 实现 方法 ,其 特征 在 于 ,所 述 
双 足 机 器 人 的 逆 运 动 学 公式 为 : 


a = tan 一 一 
B=tan De +1 =8 
2bf 
it =b? = 
= COs 
2pc 

g=0-B+} 

=0-a 


其 中 a、b、c、d、e 分 别 为 第 一 与 第 二 关节 的 连 杆 长 度 、 第 二 与 第 三 关节 的 连 杆 长 度 、 第 三 
与 第 四 关 贡 的 连 杆 长 度 、 第 四 与 第 五 关节 的 连 杆 长 度 、 第 五 关节 与 脚板 的 垂直 距离 ;:q\B、 
YO. 由 为 第 一 到 第 五 关节 的 关节 有 角 。 
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4. 根 据 权 利 要求 2 所 述 的 机 器 人 低 运 算 要 求 的 动态 步 态 的 实现 方法 ,其 特征 在 于 ,所 述 
四 足 机 器 人 的 逆 运 行 学 公式 为 : 


其 中 a、b、c 分 别 为 第 一 与 第 二 关节 的 连 杆 长 度 、 第 二 与 第 三 关节 的 连 杆 长 度 、 第 三 关节 
与 足 端的 距离 ;a、B、Y 分 别 为 第 一 到 第 三 关节 的 关节 角 。 
5. 根 据 权 利 要 求 2 所 述 的 机 器 人 低 运 算 要 求 的 动态 步 态 的 实现 方法 ,其 特征 在 于 ,所 述 


aY 
a=tan 一 
x 


六 足 机 器 人 的 逆 运行 学 公式 为 :1B=tan 


其 中 d 的 计算 公式 为 :d= Jz? +(x? +y -aP , 

其 中 a、b、c 分 别 为 第 一 与 第 二 关节 的 连 杆 长 度 、 第 二 与 第 三 关节 的 连 杆 长 度 、 第 三 关节 
与 足 端 的 距离 ;a、B、Y 分 别 为 第 一 到 第 三 关节 的 关节 角 。 
6. 根 据 权利 要 求 1 所 述 的 机 器 人 低 运 算 要 求 的 动态 步 态 的 实现 方法 ,其 特征 在 于 ,确定 
了 足 端 轨迹 的 取 点 后 ,将 每 个 时 刻 每 个 足 端 的 点 代入 逆 运 动 学 公式 ,计算 出 每 个 足 在 各 个 
时 刻下 的 各 个 关节 的 运动 角度 。 
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机 器 人 低 运 算 要 求 的 动态 步 态 的 实现 方法 

技术 领域 

[0001] 本 发 明 涉及 机 器 人 领域 ,尤其 涉及 一 种 机 器 人 低 运 算 要 求 的 动态 步 态 的 实现 方 


YK o 


背景 技术 

[0002] ”在 创 客 教育 领域 中 ,各 种 学 习 平台 如 小 车 和 仿生 机 器 人 ,由 于 用 于 学 习 , 因 此 不 能 
将 平台 设计 地 太 大 ,价格 不 能 太 过 于 昂贵 ,这 意味 着 用 于 创 客 教育 的 机 器 人 在 动力 和 主 控 
心 片 的 运算 能 力 上 与 大 型 机 器 人 有 较 大 的 差距 .因此 在 市 面 上 用 于 教育 的 小 狗 机 器 人 、 人 
型 机 器 人 ,大 多 只 能 使 用 较为 缓慢 的 静态 步 态 ,在 使 用 过 程 中 特别 不 方便 ,这 主要 是 是 受 限 
于 价格 和 运算 能 力 的 结果 。 
[0003] ”为 了 解决 教育 足 式 机 器 人 难以 快速 步行 的 问题 ,必须 采用 一 种 新 的 步 态 方法 ,应 
用 在 低 运 算 能 力主 控 世 片上 ,使 得 在 尽 可 能 减少 运算 需求 的 情况 下 ,实现 机 器 人 的 动态 步 
未 


IOo 


发 明 内 容 

[0004] ”针对 目前 技术 中 存在 的 不 足 之 处 ,本 发 明 提供 一 种 机 器 人 低 运 算 要 求 的 动态 步 态 
的 实现 方法 ,选取 尽量 少 的 点 来 确定 机 器 人 腿 部 的 运动 轨迹 ,根据 对 应 的 逆 运 动 学 公式 , 计 
算出 各 个 时 刻下 的 各 个 关节 角度 ,然后 根据 具体 使 用 方式 得 到 艇 机 具体 位 置 值 , 主 控 蕊 片 
只 需 发 送 盘 机 具体 位 置 值 指令 给 能 机 ,控制 能 机 在 一 定时 间 内 转动 到 特定 角度 , 便 可 完成 
整个 步 态 ,而 无 须 进行 更 多 的 运算 。 

[0005] ”为 实现 上 述 目 的 ,本 发 明 提 供 一 种 机 器 人 低 运 算 要 求 的 动态 步 态 的 实现 方法 , 包 
括 以 下 步骤 : 

[0006] ”模型 建立 :根据 不 同 的 腿 型 结构 ,建立 单 腿 运动 学 模型 并 且 采 用 对 应 的 逆 运 动 学 
公式 ; 

[0007] ”确定 步 态 :根据 机 器 人 运动 轨迹 ,选择 多 个 运动 点 来 模拟 机 器 人 足 端的 一 个 运动 
周期 ; 

[0008] ”运动 角度 的 确定 :将 运动 点 代入 道 运 动 学 公式 ,计算 出 在 各 个 时 刻下 的 各 个 关节 
的 运动 角度 ; 

[0009] ” 步 态 实现 :根据 运动 角度 、 舵 机 的 安装 方式 和 和 角度 范围 映射 到 艇 机 具体 位 置 值 , 控 
制 能 机 完成 整个 步 态 。 

[0010] “作为 优选 ,在 模型 建立 步骤 中 ,不 同 的 机 器 人 具有 不 同 的 腿 型 ,机 器 人 共有 三 种 ， 
包括 双 足 机 器 人 、 四 足 机 器 人 和 六 足 机 器 人 ,对 应 的 腿 型 也 为 这 三 种 ;运用 仿生 学 原理 将 三 
种 腿 型 建立 对 应 的 单 腿 运动 学 模型 ,并 且 推 导出 逆 运 动 学 公式 。 

[0011] ”作为 优选 ,所 述 双 足 机 器 人 的 逆 运 动 学 公式 为 


CN 109709967 B 说 AA 书 2/6 页 
a=-tm = 
Z—-e 
B ent Feet tS A 
D 2hf 
[0012] yee ht 8 
2be 
¢=0-ft7 
g-0-a 
[0013] ”其 中 D 和 f 为 
L=yr+(z-e) 
[0014] D=IL-d-a 3 
f= 4D ty 
[0015] ”作为 优选 ,所 述 四 足 机 器 人 的 逆 运 行 学 公式 为 : 
a-tm 
T 
Ptb -e 
0016 E e.. SOE cr 
ol Re 
yz oe 
[0017] ”其 中 d 的 计算 公式 为 : 
[0018] d= fy +(e+2 -d - 
[0019] ”作为 优选 ,所 述 六 足 机 器 人 的 道 运 行 学 公式 为 : 
a=tan™ = 
x 
r ee > ae | 
[0020] “1 好 =tan 而 
Vx ty’ -a 2bd 
jra E 
2bd 
[0021] ”其 中 d 的 计算 公式 为 : 
[0022] d= Je He +y a} 。 
[0023] ”作为 优选 ,在 确定 步 态 步骤 中 ,多 个 点 的 选择 按照 以 下 规则 :根据 机 器 人 的 运动 轨 


迹 , 选 定 进行 落 足 和 抬 足 时 运动 的 第 一 个 点 作为 落 足 点 和 抬 


线 上 选择 中 点 , 且 在 中 点 的 正 上 方 根据 抬 


人 足 部 的 运动 轨迹 ,构成 机 器 人 足 端 的 一 个 运动 周期 。 
作为 优选 ,根据 运动 轨迹 中 各 个 点 之 间 的 昌 


[0024] 


台 腿 高 度 再 


BAG Ik ,在 落 足 点 和 抬 足 点 的 连 
选取 一 点 ,将 这 些 点 连接 起 来 形成 机 器 


E 离 ,赋予 相对 应 的 时 间 ,使 得 机 器 人 在 
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行走 的 过 程 中 保持 匀速 运动 。 

[0025] ”作为 优选 ,确定 了 足 端 轨迹 的 取 点 后 ,将 每 个 时 刻 每 个 足 端 的 点 代入 道 运 动 学 公 
式 , 计 算出 每 个 足 在 各 个 时 刻下 的 各 个 关节 的 运动 角度 。 

[0026] ”作为 优选 ,在 步 态 实现 步骤 中 ,将 所 有 关节 的 运动 角度 根据 能 机 的 安装 方式 和 角 
度 范围 吴 射 到 能 机 具体 位 置信 ,并 且 规 定 相应 的 速度 , 主 控 芯 ` 片 发 送 能 机 具体 位 置 值 给 能 
机 ,控制 舵 机 在 一 定时 间 内 转动 到 特定 角度 , 即 完成 整个 步 态 的 实现 。 

[00277] ”本 发 明 的 有 益 效 果 是 :本 发 明 提 供 的 机 器 人 低 运 算 要 求 的 动态 步 态 的 实现 方法 ， 
根据 不 同 种 类 的 机 器 人 的 腿 型 的 不 同 ,采用 不 同 的 逆 运 动 学 公式 ,利用 较 少 的 点 确定 机 器 
人 单 腿 运动 一 个 周期 的 轨迹 :选取 落 足 点 和 抬 足 点 以 及 这 两 点 的 中 点 ,确定 了 每 只 腿 足 端 
轨迹 的 取 点 后 ,将 每 个 时 刻 每 条 腿 足 端的 点 带 入 逆 运 动 学 公式 ,可 得 出 每 只 腿 在 各 个 时 刻 
下 的 各 个 关节 角度 ,最 后 将 所 有 关节 角度 根据 舵 机 的 安装 方式 和 和 角度 范围 映射 到 艇 机 具体 
位 置 值 ,并 规定 相应 的 速度 , 主 控 芯 片 只 需 发 送 能 机 位 置 值 指令 给 舵 机 ,控制 能 机 在 一 定时 
间 内 转动 到 特定 角度 , 便 可 完成 整个 步 态 ,而 无 须 进 行 更 多 的 运算 。 


附 图 说 明 

[0028] ”图 1 为 本 发 明 的 方法 流程 图 ; 

[0029] ”图 2 为 本 发 明 的 人 型 机 器 人 的 单 腿 运 动 学 模型 
[0030] ”图 3 为 本 发 明 的 小 狗 机 器 人 的 单 腿 运 动 学 模型 ; 
[0031] ”图 4 为 本 发 明 的 六 足 机 器 人 的 单 腿 运 动 学 模型 ; 
[0032] ”图 5 为 人 型 机 器 人 单 腿 步 态 周期 轨迹 ; 

[0033] ”图 6 为 人 型 机 器 人 双 腿 的 运行 次 序 表 ; 

[0034] ”图 7 为 小 狗 机 器 人 单 腿 步 态 周期 轨迹 ; 

[0035] ”图 8 为 小 狗 机 器 人 四 腿 的 运动 次 序 表 ; 

[0036] ”图 9 为 六 足 机 器 人 单 腿 步 态 周期 轨迹 ; 

[0037] ”图 10 为 六 足 机 器 人 两 组 腿 的 运动 次 序 表 。 

具体 实施 方式 


[0038] “为 了 更 清楚 地 表述 本 发 明 , 下 面 结合 附 图 和 有 具体 实施 例 对 本 发 明 作 进一步 地 描 
pel 请 参阅 图 1 ,本 发 明 提供 一 种 机 器 人 低 运 算 要 求 的 动态 步 态 的 实现 方法 ,包括 以 下 
PREET: 根据 不 同 的 腿 型 结构 ,建立 单 腿 运 动 学 模型 并 且 采 用 对 应 的 逆 运 动 学 公 
和 :根据 机 器 人 运动 轨迹 ,选择 多 个 运动 点 来 模拟 机 器 人 足 端的 一 个 运动 周期 ; 
运动 角度 的 确定 :将 运动 点 代入 逆 运 动 学 公式 ,计算 出 在 各 个 时 刻下 的 各 个 关节 的 运动 角 
度 ; 步 态 实现 :根据 运动 角度 、 艇 机 的 安装 方式 和 角度 范围 映射 到 艇 机 具体 位 置 值 ,控制 舵 
机 完成 整个 步 态 。 在 本 实施 例 中 ,因为 不 同 的 机 器 人 腿 型 结构 是 不 同 的 ,根据 机 器 人 的 具体 
类 型 选择 最 合适 的 单 腿 运动 异型， 采用 最 佳 的 逆 运 动 学 公式 ,这样 才能 使 得 机 器 人 稳定 工 
作 ; 目 前 市 面 上 主要 为 三 种 类 型 机 器 人 :以 人 型 机 器 人 为 代表 的 双 足 机 器 人 ,以 小 狗 机 器 人 
为 代表 的 四 足 机 器 人 以 及 六 足 机 器 人 ,下 面 以 这 些 机 器 人 作为 具体 实施 方法 阐述 本 发 明 。 
[0040] ”请 参阅 图 2 至 图 4, 运 用 仿生 学 原理 ,建立 单 腿 运 动 学 模型 ,在 人 型 机 器 人 中 , 单 腿 
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具有 5 个 自由 度 , 其 中 a\b\c\d\e 分 别 为 第 一 与 第 二 关 贡 的 连 杆 长 度 、 第 二 与 第 三 关节 的 连 
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杆 长 度 、 第 三 与 第 四 关节 的 连 杆 长 度 、. 第 四 与 第 五 关节 的 连 杆 长 度 、 第 五 关节 与 脚板 的 垂直 
距离 ;a、B、Y 、®、g 为 第 一 到 第 五 关节 的 关节 和 角 ; 小 狗 机 器 人 的 单 腿 运 动 学 模型 的 单 腿 运 
动 学 模型 , 单 腿 具有 3 个 自由 度 ,其 中 a、b、c 分 别 为 第 一 与 第 二 关节 的 连 杆 长 度 、 第 二 与 第 三 


关节 的 连 杆 长 度 、 第 三 关节 与 足 端 的 距离 ;a、B、Y 分 别 为 第 一 到 第 三 关节 的 关节 角 ; 六 足 机 


器 人 的 单 腿 运 动 学 模型 , 单 腿 上 共有 3 个 自由 度 ,其 中 a、b、c 分 别 为 第 


一 与 第 二 关节 的 连 杆 长 


度 、 第 二 与 第 三 关节 的 连 杆 长 度 、 第 三 关节 与 足 端 的 距离 ;a、B、Y 分 别 为 第 一 到 第 三 关节 的 


关节 角 。 
[0041] “ 双 足 机 器 人 的 逆 运 动 学 公式 为 : 
i 
Z—-e 
patent tent tf 
D 2bf 
[0042] 9 Se m 
2be 
ģ=0- 8+7 
p=0-a 
[0043] ”其 中 D 和 f 为 : 
L=yr+(z-e) 
[0044] sD=L-d-a 
f= yD ty’ 
a-m 
rs 
[0045] “四 足 机 器 人 的 逆 运 0 


[0046] 其 中 d 的 计算 公式 为 : 


[0047] d= iy Het? -a 


[0048] ”六 足 机 器 人 的 逆 运 行 学 公式 为 : 


7 
a=tan = 
ab td’ -e 
[0049] a $+ E a 


Fr -a 2bd 


2 
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L0050] ”其 中 d 的 计算 公式 为 : 
[0051] d= yz? +(x? +y a’ 。 


[0052] ”推导 出 相应 的 单 腿 道 运 学 公式 后 ,根据 实际 的 机 器 人 结构 便 可 得 到 足 端 处 于 确定 
位 置 时 ,各 个 关节 的 角度 。 以 人 形 机 器 人 为 例 , 测 量 出 a、b、c、d、e 的 长 度 , 确 定 一 个 足 端 位 
置 ,比如 空间 坐标 为 (20,20,200) , 带 入 对 应 的 公式 ,得 出 足 端 位 置 在 (20,20,200) 时 ,得 到 
各 个 关节 的 角度 大 小 。 

[0053] “对 于 人 型 机 器 人 ,为 了 使 得 轨迹 中 的 点 数 尽 量 少 , 减 小 主 控 世 片 的 运算 负担 ,在 单 
腿 轨迹 只 选取 尽量 少 的 点 ;首先 选取 抬 足 点 中 和 落 足 点 加 ,同时 在 这 两 个 点 的 连 线 上 选取 
其 中 点 @@, 且 在 中 点 @@ 的 正 上 方 根据 抬 腿 高 度 选 取 抬 高 点 @@, 为 了 使 得 机 器 人 足 端的 轨迹 
更 加 圆滑 ,可 以 在 额外 补充 两 个 点 : 抬 足 点 @、 落 足 点 @@ 分 别 与 抬 高 点 @ 的 连 线 的 中 点 @、 
由 ,人 型 机 器 人 的 足 端 根据 序号 顺序 依次 到 达 轨 迹 上 的 点 ,最 后 回 到 序号 四 ,完成 一 个 单 腿 
周期 。 因 为 人 型 机 器 人 只 有 两 条 腿 , 在 行走 的 过 程 中 需要 保证 至 少 有 一 条 腿 处 于 支撑 期 ,加 
中 深 色 填充 的 表示 该 条 腿 处 于 支撑 期 ,无 填充 表示 处 于 摆动 期 ,因此 人 型 双 腿 的 运动 次 序 
表 中 ,在 和 @ 两 个 点 上 ,会 连续 两 个 时 段 , 以 增加 行走 过 程 中 的 稳定 性 。 

[0054] ”在 具体 的 应 用 中 ,由 于 大 多 数 人 形 机 器 人 的 质心 位 于 两 条 腿 的 髋 关节 之 间 , 因 此 
在 行走 的 过 程 中 需要 把 重心 转移 到 处 于 支撑 期 的 腿 上 ,但 由 于 在 转移 重心 的 过 程 中 ,由 于 
质心 的 加 速 运 动 会 产生 与 加 速度 方向 相反 的 惯性 力 ,导致 重力 和 惯性 力 的 合力 外 移 至 支撑 
面 外 ,致使 机 器 人 行走 时 侧 翻 ,为 了 解决 这 个 问题 ,本 申请 在 实际 应 用 过 程 中 ,在 人 型 机 器 
人 双 腿 支撑 期 实现 对 重心 的 转移 ,利用 重心 转移 减速 的 时 期 完成 迈 腿 , 从 而 完成 重心 的 稳 
定 转移 。 

[0055] “对 于 以 小 狗 机 器 人 为 代表 的 四 足 机 器 人 , 共 选 取 8 个 点 :首先 选取 抬 足 点 中 和 落 足 
点 加 ,同时 在 这 两 个 点 的 连 线 上 选取 中 点 @, 且 在 中 点 @ 的 正 上 方 根据 抬 腿 高 度 选取 抬 高 
点 图 ,为 了 使 得 整个 轨迹 更 加 圆滑 ,再 分 别 选 择 抬 足 点 驯 与 抬 高 点 @ 连 线 的 中 点 @@、 抬 高 点 
鲜 与 落 足 点 四 连 线 的 中 点 由 、 落 足 点 四 与 中 点 @ 连 线 的 中 点 @ 以 及 抬 足 点 四 与 中 点 人 四 连 线 
的 中 点 @。 图 中 深 色 填充 表示 该 腿 处 于 支撑 期 ,无 填充 表示 处 于 摆动 期 ;由 于 小 狗 机 器 人 的 
四 条 腿 是 相同 的 ,都 以 肘 方 向 向 后 的 方式 安装 在 躯体 上 ,因此 小 狗 机 器 人 的 质心 在 水 平地 
面 的 投影 会 较 躯 体 几 何 中 心 偏 后 , 且 在 小 狗 机 器 人 运动 的 时 候 质心 的 惯性 力 和 重力 的 合力 
的 延长 线 与 水 平面 的 交点 会 更 靠 后 ,因此 四 条 腿 的 足 端 所 形成 支撑 面 会 比 躯 体 的 投影 面 更 
靠 后 ,否则 机 体 将 会 往 运动 反 向 相反 的 方向 倾倒 。 

[0056] ”对 于 六 是 机 器 人 ,同样 的 选取 几 个 点 :首先 选取 抬 足 点 和 落 足 点 @, 抬 足 点 和 
落 足 点 @@ 连 线 的 中 点 由 , 且 在 中 点 由 的 正 上 方 根据 抬 腿 高 度 选 取 抬 高 点 @ ,由 于 六 足 机 器 
人 的 结构 元 余 , 所 以 可 以 名 略 六 足 机 器 人 的 平衡 ,只 对 足 端 轨迹 和 迈 腿 次 序 进 行 设计 ,以 六 
足 机 器 人 的 三 角 步 态 为 例 , 左 前 足 \ 左 后 足 和 右 中 足 为 一 组 PRAMAS APE. ABE AA 
后 足 为 组 B, 同 一 组 的 腿 会 处 于 同一 时 期 (支撑 期 或 摆动 期 ) 。 

[0057] ”为 了 使 得 机 器 人 在 行走 过 程 中 保持 匀速 运动 ,所 有 的 腿 都 按照 相同 的 速度 进行 运 
动 ,因此 根据 轨迹 中 相 邻 点 之 间 的 距离 ,赋予 相应 的 时 间 ; 再 确定 了 每 只 腿 足 端 轨迹 的 取 点 
后 ,将 每 个 时 刻 每 条 腿 足 端的 点 的 坐标 值 代 入 逆 运 动 学 公式 ,可 得 出 每 只 腿 在 各 个 时 刻下 
的 各 个 关节 角度 。 
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[0058] “最 后 将 所 有 关节 角度 根据 舵 机 的 安装 方式 和 角度 范围 映射 到 舵 机 有 具体 位 置 值 ,并 
根据 实际 需求 规定 相应 的 速度 , 主 控 忆 片 只 需 发 送 舵 机 具体 位 置 值 指令 给 能 机 ,控制 能 机 
在 一 定时 间 内 转动 到 特定 角度 , 便 可 完成 整个 步 态 ,而 无 须 进 行 更 多 的 运算 。 例 如 某 一 艇 机 
安装 位 置 确 定 了 起 始 舵 机 位 置 值 为 500, 首 运动 学 公式 得 出 该 关节 角度 为 30° ,该 舵 机 的 角 
度 范围 为 0"~240° ,对 应 的 舵 机 值 为 0~1000, 因 此 确定 该 关节 艇 机 的 舵 机 值 为 500 填 30/240/ 
1000, 当 艇 机 在 一 定时 间 内 达到 该 舵 机 值 时 , 即 实现 完成 对 该 动态 步 态 的 实现 。 

[0059] ”本 发 明 的 优势 在 于 : 

[0060] 1) 根据 不 同 的 机 器 人 的 运动 特点 ,建立 不 同 的 单 腿 运 动 模型 ,采用 对 应 的 逆 运 动 
学 公式 ,从 而 使 得 机 器 人 运动 更 加 稳定 ; 
[0061] ”2) 选择 具有 代表 性 的 点 代表 腿 部 的 运动 轨迹 ,将 这 些 点 的 坐标 代入 公式 ,最 终 得 
到 艇 机 值 ; 

[0062] ”3) 使 用 艇 机 值 完成 整个 步 态 周期 , 免 去 主 控 心 片 对 于 步 态 运动 的 大 量 的 运算 。 
[0063] ”以 上 公开 的 仅 为 本 发 明 的 几 个 具体 实施 例 , 但 是 本 发 明 并 非 局 限于 此 ,任何 本 领 
域 的 技术 人 员 能 思 之 的 变化 都 应 落 入 本 发 明 的 保护 范围 。 
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根据 不 同 的 腿 型 结构 ， 建 立 单 腿 运 动 
学 模型 并 且 采 用 对 应 的 递 运动 学 公式 


根据 机 器 人 运动 轨迹 ， 选 择 多 个 运动 
点 来 模拟 机 器 人 足 端的 一 个 运动 周期 


将 运动 点 代入 递 运动 学 公式 ， 计 算出 
在 各 个 时 刻下 的 各 个 关节 的 运动 角度 
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